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I. INTRODUCTION 


Translational oscillators with a rotational actuator 
(TORA) were originally used as a simplified model for 
studying the natural vibration phenomenon of dual spin 
spacecraft. Due to their outstanding characteristics such as 
light weight, low energy consumption, low cost, and 
strong flexibility, they have been widely used in aerospace 
[1, 2, 3], defense and military industry [4], mechanical 
manufacturing [5], and other fields. It is currently 
commonly used as a nonlinear benchmark system for 
nonlinear controller design, verification of the control 
performance of nonlinear control algorithms, or teaching 
research. This study simplifies the model of a dual-spin 


spacecraft to consist of an unpowered small car and a 


driven small ball [15]. 
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Abstract— The purpose of this study is to control the TORA system 
through the MATLAB/Simulink simulation platform. The TORA system is a 
classical two-degree-of-freedom under-driven mechanical system, and this 
paper mainly focuses on the design of the control scheme for the swing 
angle of the ball. Firstly, the transfer function is established in the complex 
domain through the dynamical equations of the system. Then, the 
traditional PID controller, the triangular membership function fuzzy PID 
controller, and the double S type membership function fuzzy PID controller 
were designed. Finally, the simulation results are analyzed to compare the 
parameter performance of the three controllers. The fuzzy PID controller 
using the double S membership function is better than the other two 
controllers in terms of overshoot and adjustment time and has good 


practicability, stability, speed, and accuracy. 


The TORA system is a typical underactuated mechanical 
system that can serve as a benchmark system in control 
theory research for validating different algorithms. In the 
initial TORA system, the ball rotated in the horizontal 
plane, and currently, many scholars have studied the 
problem of the ball's rotation in the vertical plane. The 
control methods of the TORA system mainly include the 
PID method [6], feedback method [7], back-stepping 
method, energy-based control method [8], and sliding 
mode control method [9, 10, 11, 12]. 

This study first analyzes the dynamic equations of the 
vertically underactuated TORA system and then 
establishes a simulation model, mainly using traditional 
PID controllers and fuzzy PID controllers to control the 
TORA In order to further the 


system. compare 
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performance of controllers, a comparison was made 
between triangular membership functions and double 
S-shaped membership functions in the design of fuzzy PID 
controllers [13, 14]. Finally, a simulation model was 
established using the Simulink module of MATALAB to 


conduct simulation experiments on the TORA system. 


II. TORA SYSTEM MATHEMATICAL 
MODELING 
The model parameters of the TORA system are: car 
mass M=1.3608 kg, ball mass m=0.096kg, 


counterclockwise rotation angle 0 (rad) from the vertical 


downward direction, radius of ball rotation r=0.0592 m, 
distance of car movement x(m), input torque t(N-m), car 
friction coefficient -0.1N/m/sec, spring elasticity 
coefficient k=186.3N/m, center of mass rotational inertia 
J=0.0002175kg*m7, and gravity acceleration g=9.8 N/ m’. 
The TORA system is shown in Figure 1. It is composed of 
a small car in a horizontal direction and a small ball in a 
circular motion inside the car, and the left end of the car is 
connected to the wall through a spring. Drive the small 
ball in a circular motion to move the car horizontally. 
Dynamically model the TORA system using the Lagrange 


equation. 
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Fig.l] TORA System Schematic Diagram 


Firstly, the sum of the kinetic energy of the car and 
the kinetic energy of the ball is the total kinetic energy K 
of the TORA system, that is: 


K= 5 (M + me + mrx60 +5(M +m)62 + mgr cos @ a (1) 
We taking the horizontal plane as the reference plane 
for gravitational potential energy, the car moves on the 
horizontal plane and therefore do not possess gravitational 
potential energy. So the gravitational potential energy P of 
the TORA system is the sum of the gravitational potential 
energy of the ball and the elastic potential energy of the 
spring, that is: 
P = —mgr cos 0 Po (2) 
The Lagrangian operator function of the TORA system is 
L=K-P (3) 


www.ijaers.com 


According to the Lagrangian equation, the dynamic 


equation of the TORA system is 


d A ðL 
dt\ax) ax 

d o aL (4) 
Sl) SES ee = TF 

dt\a6) a6 


Substituting equations (1), (2), and (3) into equation (4) 

yields the dynamic model of the TORA system as follows 
(M+m)i+mrcos66—mrsind6*+kx=f (5) 

mr cos 0x + (mr? + J)6 + mgr sin 0 =T (6) 


In a vertical TORA system, our control objective is to 
place the system at a stable equilibrium point. When we 
substitute the following data (x = 0, = 0o08 =0,ġ = 
0,t=0) into equation (1), we can obtain a stable 
equilibrium point(x, ¥, Ê, 6) = (0,0,0,0), that is, when the 
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ball is in a vertical downward position. 

At this point, we linearize the TORA system. When 
the small ball is infinitely close to the vertical downward 
position, i.e., 8 is infinitely close to 0, then there is, 
cos 6 ~ 1,sin@ = 6,(d0/dt)* = 0 which is introduced 
into equations (5) and (6), resulting in 
(M +m) + mré + kx = f (7) 
mrx + (mr? +J)6+mgré =T (8) 

In the TORA system, when the car is moving 
horizontally, it will generate frictional force with the 
horizontal plane to hinder the car's movement. The 
frictional force in this article is 
f = -už (9) 
Perform the Laplace transform on equations (7), (8), and 
(9) to obtain 
(M + m)s?X(s) + mrs? O(s) + kX(s) = —usX (s) (10) 
mrs? X(s) + (mr? + J)s?0(s) + mgr (s) = t(s) (11) 


Equation (10) can be written in the following form: 


i P ke(t) 
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x(s) | mrs? 
O(s) (M+m)s2+yus+k 


Substituting equation (12) into equation (11) with the 


(12) 


control input yields 


M+m k 
o(s) (+m) 24 Hy 


w 


2 24 
t(s) sä ulm? +J) 3 i [k(mr? + J) + mgr(M +m)] 2 + ps H kmgr 


w 
Among them, w = [(M + m)(mr? +J) — m?r?]. 
Substitute the parameters of the TORA system into 
equation (13) to obtain the open-loop transfer function for 
the swing angle 0 and input torque t of the ball, which is: 


_ 6(s)___—_—- 2630s? + 180s + 336315 
t(s) s*+0.07s3 + 333s? + 10s + 18731 


G(s) (14) 


HI. TORA SYSTEM CONTROLLER 
PRINCIPLE 
3.1 Principle of Traditional PID Control 
In general control systems, the most common control 


method is to use traditional PID control (Figure 2). 


+ 
+r yue] TORA SYSTEM A 


+h 


Fig.2 Principle Framework Diagram of Traditional PID Control System 


The traditional PID controller is a linear controller 
that forms the control deviation e of the controller based 
on the difference between the given input value r(t) and the 
actual output value u(t). The output error equation of the 
traditional PID controller is as follows: 

e(t) = r(t) — u(t) (15) 
The control equation of a traditional PID controller is as 


follows: 


u(t) = K,e(t) + K | e(t)dt + moe) 


In the above equation, K, is a proportional coefficient, 


(16) 


K; is an integral coefficient, and Kp is a differential 


coefficient. The proportional coefficient is the 


amplification factor of the difference between the preset 
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value and the feedback value, and the larger the proportion, 
the higher the adjustment sensitivity. The integration 
coefficient accumulates the difference between the preset 
value and the feedback value over time, but there is a 
significant lag. The differential coefficient is the rate of 
change of the research object (i.e., the difference between 
the two differences before and after), and a corresponding 
adjustment action is given in advance based on the rate of 
change of the difference. According to the control laws of 
each coefficient, it can be seen that the proportional 
coefficient makes the reaction faster, the differential 
coefficient makes the reaction earlier, and the integral 
coefficient makes the reaction lag. Within a certain range, 
the larger the value of K, and Kp, the better the 
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adjustment effect. 
3.2 Principle of Fuzzy PID Control 

Fuzzy PID control is a control method that combines 
fuzzy logic and classical PID controllers. A PID controller 
is a common feedback controller that adjusts the control 


output based on the size of the error signal to make the 


e 


= 
fuzzy 


ec 


a de/dt 


— 


PID controller 
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system output value close to the expected value. The PID 
controller consists of a proportional term (P), an integral 
term (I), and a differential term (D). Fuzzy control mainly 
consists of three steps: fuzzification, determining fuzzy 
rules, and deblurring. The control framework diagram for 


fuzzy PID control is shown as Figure 3. 


controller 


x(t) 


— TORA SYSTEM 


Fig.3 Fuzzy PID Control Block Diagram 


In the above figure, e represents the control error, and 
ec represents the rate of change of the control error. In a 
fuzzy PID control system, e and ec are used as the two 
input variables of the controller, and the differential 
coefficients (Kp > K; ` Kp) are used as the three output 


variables of the controller. 


IV. DESIGN OF FUZZY PID CONTROLLER 
In this article, the fuzzy PID controller is a two-input, 
three-output type. The basic domain of error e is taken as 
[-0.6, 0.6], the basic domain of error rate of change is 
taken as [-0.6, 0.6], and the domain of output variables is 
taken as [-3, 3]. Divide the fuzzy domain of input and 
output variables into 7 fuzzy subsets, namely NB, NM, NS, 


ZO, PS, PM, and PB. 

In fuzzy set theory, the membership function refers to 
a function used to measure the degree of membership of an 
element to a fuzzy set. It is one of the most basic concepts 
in fuzzy sets, used to describe the degree of membership of 
elements in a certain fuzzy set. In this study, the triangular 
(trimf) and double S-type 


membership function (dsigmf) are used as the membership 


membership function 


functions of the fuzzy PID controller. Compare the results 
of two types of membership functions and choose the one 
with the best control effect as the membership function of 
the fuzzy PID controller. Their membership function 


diagrams are as follows (Figure 4, 5): 
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Fig.4 Triangle Membership Function Diagram 
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Fig.5 Double S-shaped Membership Function Diagram 


Control rules are usually established by experts based on long-term experience. By determining the input and output 


quantities of the fuzzy controller, a fuzzy subset is determined. Based on the fuzzy rules established above, a rule table for 


the fuzzy PID controller is established, as shown below (Table 1, 2, 3). 
Table 1 K, Fuzzy Rule Table 


EC 

NB PB PB PB PB PM PS 

NM PB PB PB PB PM O 

NS PM PM PM PM O PS PS 
O PM PM PS O NS NS NM 
PS PS PS O NS NM NM NM 

PM PS NS NM NM NM NB 
PB O NM NM NM NB NB 


NB NB NB NM NM NS 

NM NB NB NM NS NS 

NS NB NM NS NS O PS PS 
O NM NM NS O PS PM PM 
PS NM NS O PS PS PM PB 

PM PS NM PM PB PB 
PB PS PM PM PB PB 
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Table 3 Kp Fuzzy Rule Table 


E 
= NB NM NS O PS PM PB 
EC 
NB PS NS NB NB NB NM PS 
NM PS NS NB NM NM NS 
NS O NS NM NM NM NS 
O O NS NS NS NS NS 
PS O O O O O O 
PM PB PS PS PS PS PS PB 
PB PB PM PM PM PS PS PB 


This design system uses the Mamdani inference method to perform fuzzy inference on the established fuzzy rules in 


order to obtain control variables. 


V. TORA SYSTEM SIMULATION AND module of MATLAB, and two different membership 
RESULT ANALYSIS functions of fuzzy PID and traditional PID were compared 
This study based on the established control model and and analyzed. The system control model built is shown in 
controller, conduct simulation analysis on the TORA Figure 6,7,8. 
system. The control model was built using the Simulink 
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Fig.6 Simulink Simulations of Traditional PID and Fuzzy PID Control Systems (Ball Angle) 
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Fig.7 Simulink Simulation of Fuzzy PID Controller for Ball Angle 
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Fig.8 Response Curves of Traditional PID and Fuzzy PID Controller Systems (Ball Angle) 


Through simulation using MATLAB/Simulink 
modules, it has been found that with appropriate 
parameters, traditional PID controllers have good control 
effects on control objects that can assume precise 
mathematical models. They can meet the requirements of 
system control accuracy and rise time, but there are 
problems such as long adjustment times. As shown in 
Table 4, two fuzzy PID controllers with different 
membership functions can adjust the PID parameters of 
the system in real time. By doing so, the PID parameters 
can be more suitable for the control requirements of the 
system, resulting in better control effects than traditional 
PID controllers. Moreover, the fuzzy PID controller using 
dual S-type membership functions performs the best 


among the three controllers. 
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Table 4 Comparison of Performance Parameters 


Rise time Overshoot Adjusting 
Method é 
(s) (%) time (s) 
Tradition 
0.02 17 0.09 
PID 
Fuzzy 
f 0.08 1 0.08 
PID(trimf) 
Fuzzy 
, 0.06 0.5 0.06 
PID(dsigmf) 


VI. CONCLUSION 
The inherent TORA system is a typical 
two-degree-of-freedom underactuated mechanical system. 
This study analyzes the motion of the TORA system, 
establishes a mathematical model of the TORA system 
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using the Lagrange method, and designs a PID controller 
and two types of fuzzy PID controllers to control the 
TORA system. By adjusting their proportional constant, 
integral constant, and differential constant parameters, 
fuzzifying the fuzzy PID controller, designing fuzzy rules, 
and defuzzifying, them the TORA system can quickly and 
accurately reach a stable state, ultimately achieving a 
stable system. 

The superiority of the fuzzy PID controller with dual 
S-type membership functions over the other two 
controllers was verified through Simulink simulation. 
Under the action of the fuzzy PID controller with dual 
S-type membership functions, the system has fast response 
speed, short adjustment time, and high steady-state 


accuracy, achieving the expected goals. 
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